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Abstract 


This  report  describes  the  design  and  control  of  a  two-joint,  two-link  flexible  arm.  Our  purpose  has 
been  to  build  an  efficient  arm  in  the  sense  that  most  of  the  energy  provided  by  the  motors  is  spent  in 
doing  the  task  (moving  the  tip  mass)  instead  of  moving  the  arm  structure.  In  order  to  achieve  that,  we 
designed  a  flexible  arm  that  has  most  of  its  mass  concentrated  on  the  tip.  We  wanted  also  to  decouple 
radial  tip  motions  from  angular  tip  motions.  The  special  mechanical  configuration  that  fulfills  all  these 
specifications  is  described  in  Section  2. 

Section  3  describes  the  control  scheme  of  this  arm.  An  important  problem  when  controlling  it  was 
the  large  Coulomb  friction  of  the  motors.  A  two-nested-loop  multivariable  controller  has  been  used.  The 
inner  loop  controls  the  position  of  the  motors  while  the  outer  loop  controls  the  tip  position.  The  resolved 
acceleration  method  is  generalized  to  control  this  flexible  arm.  The  compliance  matrix  was  used  to  model 
the  oscillations  of  the  structure,  and  was  included  in  the  decoupiing/linearizing  term  of  this  controller. 
Experimental  results  are  given  in  Section  4,  and  conclusions  are  drawn  in  Section  5. 


1.  Introduction 


This  report  describes  the  design  and  control  of  a  small  two-joint,  two-link  flexible  arm  that  we  have  built 
in  our  laboratory.  This  arm  operates  in  a  plane  on  an  air  table.  The  arm  is  designed  with  exaggerated 
flexibility  to  facilitate  studying  the  control  of  flexible  structures;  and  is  very  light  in  weight  compared  tc 
the  mass  placed  at  the  tip  (there  is  no  mass  placed  at  the  elbow  joint). 

The  purpose  of  our  research  on  flexible  arms  is  to  design  more  efficient  and  faster  arms  than  the  actual 
rigid  arms.  Our  very  lightweight  arm  is  efficient  in  the  sense  that  most  of  the  energy  provided  by  the 
motors  is  spent  in  doing  the  task  (moving  the  tip  mass),  and  little  is  wasted  in  moving  the  arm  structure 
(unlike  rigid  arms). 

We  wanted  also  to  decouple  radial  motions  of  the  tip  from  angular  motions.  A  special  four-bar 
linkage  is  used  to  drive  the  elbow  joint  from  a  motor  mounted  near  the  base.  Mechanics  of  this  arm  are 
described  in  Section  2;  and  a  dynamical  model  is  developed  for  this  arm,  that  can  be  easily  extended  to 
any  n-degrees  of  freedom  lumped-mass  flexible  arm. 

Section  3  describes  the  control  scheme  of  this  arm.  An  important  problem  when  controlling  it  was  the 
large  Coulomb  friction  of  the  motors.  A  two-nested-loop  controller  has  been  used.  The  inner  loop  controls 
the  position  of  the  motors  while  the  outer  loop  controls  the  tip  position.  This  method  is  the  generalization 
to  robots  with  more  than  one  degree  of  freedom  of  the  control  method  described  in  [1],[2],[3],  which  is 
very  robust  to  changes  in  the  dynamic  friction  and  insensitive  to  the  Coulomb  friction. 

A  generalization  of  the  resolved  acceleration  method  ([4],  a.e.)  to  the  case  of  flexible  arms  is  im¬ 
plemented  in  the  outer  loop.  The  compliance  matrix  was  used  to  model  the  oscillations  of  the  structure, 
and  was  included  in  the  decoupling/linearizing  term  of  this  controller.  Experimental  results  are  given  in 
Section  4,  and  conclusions  are  drawn  in  Section  3. 


2.  Mechanical  issues 


This  arm  has  b*<"i  designed  to  fulfill  two  specifications,  from  the  mechanical  point  of  view; 

1.  the  arm  had  to  be  very  lightweight, 

2.  radial  motions  of  the  tip  had  to  be  nearly  decoupled  from  angular  motions  (if  we  neglect  the 
vibrations  because  of  flexibility). 

In  order  to  fulfill  the  first  specification,  the  links  were  made  of  a  very  lightweight  wire  (having 
consequently  a  significant  elasticity),  and  the  motor  that  moves  the  elbow  was  placed  close  to  the  base 
of  the  arm.  A  four-bar  linkage  was  used  to  transmit  the  motion  of  this  motor  to  the  elbow. 

In  order  to  fulfill  the  second  specification,  the  length  of  the  two  links  was  made  the  same,  and  the 
dimensions  of  the  four-bar  linkage  were  especially  designed. 

Subsections  2.1.  and  2.2.  study  the  kinematics  and  dynamics  of  this  arm  assuming  that  is  rigid. 
Subsection  2.3.  includes  the  flexibility  effects. 


2.1.  Kinematics 


Figure  1  illustrates  the  kinematics  of  the  arm,  neglecting  its  compliance.  The  arm  comprises  a  four- 
bar  linkage  with  pivots  at  points  O.  A,  B  and  C.  and  tip  position,  P.  Note  that  the  length  of  link  O  -  A 
is  twice  that  of  link  B  -  C\  and  links  O  -  C  and  C  -  P  are  of  equal  length.  With  points  O  and  A  fixed, 
as  shown  (for  the  sake  of  studying  kinematic  behavior-/!  is  not  normally  fixed),  it  can  be  shown  that  the 
tip  describes  a  path  very  close  to  a  straight  line  through  the  origin  ( O )  at  an  angle  of  45  degrees  to  the 
x-axis.  That  is,  as  the  radius  to  the  tip  (p)  varies,  the  tip  angle  (7)  remains  close  to  45  degrees  (-,0).  The 
point  Po  is  the  ideal  tip  position,  assuming  that 

p  =  po  =  2  ■  /  •  cos(ip  -  45).  (1) 


Analysis  of  the  geometry  reveals  that  the  error  (deviation  from  ideal)  in  the  tip  angle  is  given  by 


f-,  %  f/2 


and  the  error  in  tip  radius  by 

e„  sin(<p)  -  cos(<p) 

€p  ”  2  •  /  ~  €  2  •  y/2  ' 

where  ep  is  the  radial  error,  efi  is  the  normalized  radial  error, 

_  2  •  (a  +  cos(ip))  •  (1  -  sin(ip)) 

1  -  2  •  (a  +  cosOp))  •  cos (p?)  ' 

and 


(2) 


(3) 


(4) 


a  -  a/1.  (5) 

Figure  2  gives  the  normalized  errors  as  functions  of  the  normalized  tip  radius  (p/( 2  •  t))  for  several 
values  of  parameter  a  (a/C)-  The  value  p/(2  0  represents  the  percentage  of  ami  extension,  and  has  a 
maximum  range  of  0  —  1.0.  For  a  typical  value  of  a,  say  0.2,  we  see  from  the  plot  that  the  deviations  are 
quite  small  (<  1%)  in  the  range  of  .4  <  p/(2-f)  <  .8;  and  less  than  5  %  in  the  range  .25  <  p/(2-l)  <  .9.  By 
restricting  the  range  of  motion  of  the  arm,  then,  we  can  minimize  the  deviation  from  ideal  behavior.  While 
the  deviation  will  require  consideration  for  precise  tip  positioning,  that  is  in  the  kinematic  calculations, 
the  effects  can  be  ignored  with  regard  to  system  dynamics.  This  can  simplify  dynamic  calculations 
substantially. 

This  kinematic  design  provides  a  means  for  decoupling  the  two  joint  actuators.  We  mount  one  of  the 
actuators  so  that  it  drives  link  0  -  A  with  respect  to  ground  (see  Figure  3).  The  net  effect  of  a  torque 


4 


from  this  actuator  is  a  tangential  force  at  the  tip.  We  mount  the  second  actuator  so  that  it  drives  link 
O  -  C  v-iih  respect  to  link  O  —  A.  Thus,  it  generates  equal  and  opposite  torques  on  the  two  links;  the  net 
effect  is  a  radial  force  at  the  tip.  In  terms  of  position  control,  a  displacement  of  the  first  actuator  generates 
a  pure  tangential  motion;  of  the  second,  a  pure  radial  motion.  The  decoupling  effects  are  based  on  the 
ideal  (straight-line)  behavior  of  the  arm;  there  will  be  some  deviation  from  this  fully  decoupled  behavior, 
especially  near  Le  extremes  of  travel  (p  =  0 ,p  =  1)  of  the  arm.  One  consequence  of  this  geometry  is 
that  there  is  r  >  torque  coupling  between  actuators;  a  torque  at  one  actuator  generates  no  reaction  torque 
at  the  oir  r.  This  simplifies  control,  and  possibly  reduces  energy  usage  of  the  arm. 


2.2.  Rigid  arm  dynamics 


We  develop  in  this  subsection  the  dynamics  of  this  arm  assuming  that  is  rigid.  We  will  complete  this 
model  in  the  next  subsection,  adding  the  effects  of  the  link  compliance. 


Using  Lagrange  equations  (or  Newton-Euler  equations)  we  get: 


1  p 

F-, 


=  m  ■  ( 


P 

P  •  7 


-p  •  Y 
2  ■  P  •  7 


X 


(6) 


where  FP,F~,  arc  respectively  the  radial  and  angular  forces  applied  to  the  tip,  (p, 7)  are  the  polar  coordi¬ 
nates  of  the  tip  and  m  is  the  tip  mass. 

We  have  to  express  the  above  equation  in  terms  of  the  torques  T\  and  r2  generated  by  the  motors. 
Because  of  the  decoupling  between  the  two  motors,  and  applying  the  principle  of  virtual  work,  the  next 
approximate  expression  easily  follows; 


Tx 

T2 


0  2  ■  /  •  cos(ip) 

2  ■  l  ■  sin('yr)  0 


(7) 


2.3.  Compliance 


For  a  system  (2-joint,  planar  arm)  that  can  be  modelled  as  having  all  its  mass  concentrated  at  the  tip,  it 
is  useful  to  think  in  terms  of  the  compliance  at  the  tip.  Control  of  the  tip  mass  then  becomes  a  matter 
of  producing  deflections  to  generate  the  appropriate  tip  forces.  This  is  the  two-dimensional  equivalent  of 
deflecting  a  spring  to  generate  a  force. 

It  can  be  shown  that  the  compliance  (or  stiffness)  of  a  linear,  two-dimensional  system  can  be  defined 
by  two,  orthogonal  stiffness  values,  i.e.  decoupled  [5j.  These  principal  axes  of  stiffness  are  offset  by  some 
angle  from  the  coordinate  axes  of  the  arm.  Figure  4  shows  a  general,  planar  structure  (arm)  connecting 
the  tip  with  a  fixed  base.  The  vectors  emanating  from  the  tip  indicate  the  magnitude  and  direction  of  the 
principal  stifnesses.  A  force  along  either  of  these  axes  (u/v)  produces  a  deflection  parallel  to  the  force, 
while  a  force  not  aligned  with  the  axes  produces  a  component  of  deflection  perpendicular  to  the  force. 
The  general  relationship  between  forces  and  displacements  is  given  by 


(  F*  \  -  (  ku  kU  \  (  6x\ 
\Fy  )-\  k22  )'\Sy  ) 


(8) 


where  Fx  and  Fy  are  forces  applied  to  tip;  6x  and  6y  are  tip  deflections;  and  ktJ  are  stiffness  coefficients. 

We  can  think  of  the  system  as  comprising  two  separate  parts,  as  shown  in  Figure  5:  a  rigid  positioner 
which  controls  the  position  of  a  cage;  and  inside  the  cage,  a  set  of  orthogonal  springs,  corresponding 
to  the  principal  stiffnesses,  that  connect  the  cage  to  the  tip.  Thus,  by  appropriately  positioning  the  cage 
using  the  arm  (positioner),  we  can  deflect  the  springs  and  generate  arbitrary  forces  on  the  tip. 

The  question  now  arises  as  to  how  to  find  the  relationship  between  forces  and  displacements,  i.e.  the 
stiffness  matrix  at  the  tip.  For  simple  systems,  these  value;  can  be  calculated.  For  more  complex  systems, 
or  for  confirming  analytical  results,  we  can  deduce  these  from  observations  of  the  natural  frequencies  of 
the  mechanical  system.  The  stiffness  matrix  will,  of  course,  vary  with  the  configuration  of  the  arm,  in 
particular,  with  the  extension  (p)  of  the  arm.  Note  that  we  have  defined  the  stiffness  matrix  with  respect 
to  coordinates  x  -  y  aligned  with  the  base-to-tip  vector.  We  do  this  so  that  the  stiffness  matrix  depends 
only  on  the  variable  p.  Thus  a  coordinate  rotation  is  needed  to  transform  to  world  coordinates.  For  use 
on  a  digital  computer,  tabular  storage  of  stiffness  parameters  is  indicated. 

The  first  approach  involves  calculating  stiffness  parameters  for  individual  links,  then  combining  these 
through  appropriate  force/moment  analysis.  The  stiffness  parameters  can  be  defined  either  in  terms  of 
principal  stiffness  vectors  (magnitude  and  orientation  of  the  principal  stiffnesses);  or  in  terms  of  the 
stiffness  matrix.  In  either  case,  three  values  are  required  (for  any  value  of  the  extension,  p)\  and  these 
values  will  be  referenced  to  the  coordinate  axis  aligned  with  the  base-to-tip  radius  vector.  Performing 
this  analysis  for  our  particular  arm  with  its  four-bar  linkage,  we  get  the  following  compliance  matrix  C, 
which  is  the  inverse  of  the  stiffness  matrix  described  in  expression  (8); 


where: 


(  6x  ^  s  (  Cu  c'-2 

V  b  )  ~  \  *-2,1  C22 


_  _  l2  ■  stn2(p)  „  _  *Cn 

fce  4 


(9) 


(10) 


c\2  =  C2,i  =  l2  ■  sin(p)  •  cos(p)/kc 


(11) 


C2J2  =  l2  '  COS2(p)/*c, 


(12) 


and  kt,,  are  the  individual  stiffnesses  of  links  0  -  C  and  C  -  P  respectively.  Notice  that  the  stiffness  of 
link  A  -  B  does  not  appear  because  this  link  is  not  subjected  to  bending,  only  tension  and  compression. 

Figure  6  plots  the  calculated  stiffness  vectors  for  various  configurations  of  the  experimental  arm. 
While  it  may  be  more  convenient  for  control  purposes  to  store  values  of  stiffness  matrix,  the  vector  plots 
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give  a  readily  understandable  picture  of  the  stiffness  characteristics.  Double  arrowheads  in  figure  indicate 
vectors  extend  beyond  available  space. 

In  the  second  (empirical)  approach  to  finding  stiffness  parameters,  we  excite  the  natural  modes  of 
vibration  of  the  system,  having  known  tip  mass,  keeping  both  joints  angles  fixed.  We  can  do  this  by 
plucking  the  system  and  observing  its  time  response;  or  by  exciting  with  an  adjustable-frequency  harmonic 
input  signal,  and  seeking  the  peak  responses.  Either  way,  we  obtain  the  magnitudes  and  directions  of 
the  two  principal  vibration  modes,  which  correspond  to  the  two  principal  stiffnesses.  The  relationship 
between  frequency  and  stiffness  is  given  by 


uJn 


(13) 


where  k  is  one  principal  stiffness,  un  the  corresponding  frequency  and  m  the  up  mass.  Using  this 
approach,  we  can  find  values  for  a  substantial  number  of  configurations  (values  of  p)  and  interpolate  to 
get  intermediate  values  to  fill  a  table;  or  experimentally  find  values  for  only  a  few  configurations,  and 
use  an  analytical  model  of  the  system  to  extrapolate  over  the  needed  range.  Experimental  results  of  this 
approach  are  described  later  in  Section  4. 

The  dynamic  model  of  an  n-degrces  of  freedom  lightweight  flexible  arm  with  the  mass  concentrated 
at  the  tip  can  be  represented  by  the  scheme  of  Figure  7,  using  the  stiffness/compliance  matrix.  This  is  a 
generalization  of  the  dynamics  of  the  rigid  arm  case  (rigid  aim  dynamics  are  a  block  in  this  diagram).  In 
this  figure,  /  is  the  jacobian  of  the  rigid  arm  kinematics,  that  relates  motor  velocities  to  tip  velocities  (in 
our  particular  arm,  in  polar  coordinates);  7>  is  the  matrix  of  expression  (7)  that  transforms  tip  forces  into 
motor  torques;  F  are  the  tip  forces;  P  is  the  tip  position,  and  are  the  corresponding  joint  coordinates 
(actuator  coordinates)  assuming  that  the  arm  is  undeflected. 


3.  Control  issues 

3.1.  General  scheme 

Our  arm  presents  two  special  problems  that  most  arras  do  not  have;  a  large  Coulomb  friction  in  the 
joints,  and  flexibility  in  the  links.  They  require  the  design  of  a  special  controller  that  is  described  in 
this  section.  We  use  four  measurements  to  control  this  arm:  a  tracking  camera  gives  the  tip  position  in 
cartesian  coordinates  (x,y),  and  two  potentiometers  mounted  on  the  motors  give  the  motor  position  (joint 
angles).  Because  the  arm  has  been  designed  in  such  a  way  that  its  rigid  dynamics  are  nearly  decoupled 
in  polar  coordinates,  we  will  use  these  coordinates  for  the  tip  position  control.  Transformation  to  polar 
coordinates  from  cartesian  measurements  given  by  the  camera  is  straightforward  and  does  not  introduce 
any  error  because  it  does  not  use  any  kinematic  parameter  of  the  arm. 

In  order  to  remove  the  effects  of  joint  Coulomb  friction  and  of  time-varying  dynamic  friction,  a 
two  nested  multivariable  loop  control  structure  is  proposed:  we  close  an  inner  loop  around  the  motor, 
that  controls  the  joint  (motor)  angles;  and  then  an  outer  loop  is  closed  that  controls  the  tip  position. 
The  general  scheme  of  this  control  structure  is  shown  in  Figure  8.  The  inner  controller  uses  the  errors 
between  the  actual  (6>m)  and  the  commanded  motor  positions  (Qmr),  and  generates  control  signals  which 
are  the  currents  for  the  two  motors.  The  outer  loop  basically  uses  the  errors  between  the  actual  ( P )  and 
the  desired  ( Pr )  positions,  and  generates  control  signals  which  are  the  command  positions  for  the  motors 
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at  the  inner  loop.  This  scheme  is  the  generalization  to  the  multi-degree  of  freedom  flexible  arm  case  of 
a  control  scheme  robust  to  friction  developed  in  Feliu  et  al.  [1-3]. 


As  result  of  the  procedure  for  controlling  the  motor  position  developed  in  the  next  subsection,  we 
can  describe  the  dynamics  of  the  two  closed-loop  motors  as  two  decoupled  time  invariant  linear  systems. 
And,  if  we  use  high  enough  gains  in  the  controllers  of  these  loops,  the  dynamics  of  these  systems  can  be 
made  much  faster  than  the  dynamics  of  the  arm  and,  therefore,  can  be  neglected  in  the  design  of  the  tip 
position  control  loop.  This  greatly  simplifies  the  design  method. 

3.2.  Motor  position  control  loops 

We  use  here  the  control  scheme  described  in  [1-3].  Let  the  dynamics  of  each  motor  be  described 
by: 


K,  ■  ii 


Ji- 


dt 


Vi 


dOn. 

dt 


+  CF i  +  Cti , 


(14) 


where  Ki  is  the  electromechanical  constant  of  the  motor  t, is  its  current,  J,  is  its  polar  inertia,  V,  is  its 
dynamic  friction  coefficient,  Cti  is  the  coupling  torque  between  this  motor  and  the  mechanical  structure, 
CF,  is  its  Coulomb  friction,  and  subindex  i-  1,2,  designates  the  motor. 

Then  we  add  to  the  current  generated  by  the  motor  position  controller,  two  feedforward  terms: 


ii  =  h  +  (CFi  +  Cti)IK„  (15) 

the  first  one  linearizes  the  motor  system  by  compensating  for  the  Coulomb  friction  which  is  nonl.  tear, 
the  second  one  decouples  the  dynamics  of  the  motor  from  the  rest  of  the  arm. 

We  assume  that  Coulomb  friction  is  of  the  form: 


CF,(t)  =  ±  |  CFi 


06.' 


where  the  sign  is  that  of  the  motor  velocity.  Then  the  Coulomb  friction  compensation  term  is  generated 
by  knowing  the  amplitude  of  the  Coulomb  friction,  and  by  estimating  the  actual  velocity  of  the  motor 
from  position  measurements.  Comments  to  the  velocity  estimation  procedure  made  in  Subsection  4.1.  of 
[2]  remain  valid. 

In  order  to  generate  the  decoupling  term,  the  coupling  torque  Ct  may  be  directly  obtained  from 
measurements  of  strain  gauges  placed  at  the  joints,  or  can  be  estimated  from  the  actual  measurements  of 
motor  and  tip  positions  following  the  procedure  below: 

1.  Calculation  of  the  equilibrium  tip  position  Pq  =  (  po  7o  )  corresponding  to  the  arm  without  any 
deflection,  in  the  case  in  which  the  joint  angles  are  the  actually  measured  values  6n\  and  0*2-  Po 
is  calculated  from  the  direct  kinematic  model  of  the  arm. 
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2.  Calculation  of  the  actual  deflections,  obtained  from  the  actual  tip  position  and  Po- 


6  =  (  p  ~  Po  \ 

V  Po  ■  (7  -  70)  )  ' 

3.  Calculation  of  the  external  forces  F  =  (  F„  F*,^ ,  that  applied  to  the  tip  generate  such  deflections. 
This  is  obtained  from  the  stiffness  matrix  (inverting  the  compliance  matrix). 

4.  Transformation  of  these  tip  forces  into  the  corresponding  reaction  torques  at  the  joints.  These 
torques  are  the  coupling  torques  Ct  and  can  be  obtained  from  expression  (7). 


This  procedure  gives  an  approximate  estimation  of  the  coupling  torques  because  the  expressions  used 
here  are  only  approximate.  But  experiments  will  show  that  these  estimations  are  sufficient  for  decoupling 
purposes. 

It  was  shown  in  [I], [2]  that  closing  the  motor  position  loop  with  high  gain  controllers  makes  the 
system  more  insensitive  to  perturbations  (caused  by  an  imperfect  compensation  of  the  Coulomb  friction, 
a.e.),  and  to  time  varying  parameters  (dynamic  friction  coefficient,  a.e.). 

Figure  9  shows  the  resulting  inner  loop  control  scheme.  The  feedforward  and  feedback  terms  of  the 
discrete  feedback  controllers  (Kpi  and  B,(z)  respectively)  are  designed  so  that  the  response  of  this  loop 
(motor-position-control)  is  significantly  faster  than  the  response  of  the  outer  loop  (tip-position-control) 
and  without  any  overshoot.  This  is  done  by  making  the  gain  of  the  feedforward  controller  large.  It  was 
shown  in  [1],[2]  that,  in  theory,  this  gain  could  be  made  arbitrarily  large  even  in  the  case  of  the  arm 
being  a  non-minimum  phase  system.  Practical  limits  to  these  gains  are  given  by  the  saturation  current 
of  the  D.C.  motor  amplifier,  unmodelled  high  frequency  dynamics,  or  even  instability  because  of  the 
discretization  of  the  signals  when  using  digital  controllers. 

It  is  important  to  mention  that  this  controller  is  adequate  only  for  steplike  motor  position  references. 
It  is  used  here  because  we  expect  that  the  commands  for  the  motor  will  have  approximately  this  shape 
(they  will  change  very  sharply).  In  other  cases,  a  standard  P.D.  controller  may  be  used. 

When  the  closed-loop  gain  of  the  inner  loop  is  sufficiently  high,  the  motor  position  will  track  the 
reference  position  with  small  error.  Then  the  dynamics  of  the  inner  loop  may  be  approximated  by  1  when 
designing  the  outer  loop  controller. 

Then,  summarizing,  we  want  to  achieve  two  objectives  when  designing  a  controller  for  the  motor 
position: 


1.  to  remove  the  modeling  errors  and  the  nonlinearities  introduced  by  Coulomb  friction  and  changes 
in  the  coefficient  of  the  dynamic  friction, 

2.  to  make  the  position  controlled  response  of  the  motor  much  faster  than  the  response  of  the  tip 
position  control  loop  (outer  loop  in  Figure  8). 
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And  these  objectives  are  accomplished  by. 

1.  feedforward  term  that  compensates  for  Coulomb  friction, 

2.  feedforward  term  that  compensates  for  coupling  torque  between  arm  and  motors, 

3.  closing  a  high-gain  feedback  loop,  that  increases  the  robustness  of  the  system  and  speeds  the  motor 
response. 

The  fulfillment  of  the  second  objective  will  allow  us  to  substitute  for  the  inner  loop,  an  equivalent 
block  whose  transfer  function  is  approximately  equal  to  one;  i.e.  the  error  in  motor  position  is  small  and 
quickly  removed.  This  simplifies  the  design  of  the  outer  loop  as  will  be  seen  in  the  next  subsection. 

3.3.  Tip  position  control  loops 

We  describe  here  the  method  used  to  control  the  tip  position.  In  what  follows  we  assume  that  the 
dynamics  of  the  motor  position  loops  (inner  loops)  are  negligible  compared  to  the  dynamics  of  the  arm. 
If  this  assumption  holds,  the  arm  dynamics  may  be  cancelled  using  the  scheme  described  in  Figure  10  that 
transforms  these  dynamics  into  two  decoupled  double  integrators.  Then  this  method  can  be  considered 
as  an  extension  of  the  resolved  acceleration  method  ([4],  a.e.)  to  the  case  of  lightweight  two-link  flexible 
arms.  Once  the  system  has  been  reduced,  two  independent  P.D.  controllers  may  be  designed,  one  for  each 
coordinate  of  the  tip  position.  A  feedforward  term  is  added  to  avoid  delays  when  following  a  trajectory, 
and  some  integral  action  is  included  in  the  controllers  in  order  to  remove  small  errors  due  to  non  exact 
modelling  of  the  arm  kinematics. 

The  dynamics-cancelling  scheme  has  the  following  components: 

1.  First  a  positive  feedback  loop  is  closed,  that  uses  the  motor  position  calculated  from  the  tip  position 
assuming  that  there  are  not  deflections  in  the  arm  (inverse  rigid  arm  kinematics). 

2.  Inverse  of  the  jacobian  of  the  rigid  arm  kinematics.  This  component  transforms  the  deflections 
expressed  in  terms  of  the  tip  position  (difference  in  the  tip  position  between  the  deflected  and 
the  undeflected  arm  for  given  motor  angles),  into  deflections  expressed  in  terms  of  motor  position 
(difference  in  the  motor  position  between  the  deflected  and  the  undeflected  arm  for  a  given  tip 
position). 

3.  Compliance  matrix  that  relates  the  forces  needed  at  the  tip  to  move  the  mass  as  we  want,  with  the 
deflections  needed  to  achieve  this. 

4.  Component  that  computes  the  inverse  dynamics  of  the  rigid  arm  (model  (6)). 

Notice  that,  in  this  procedure,  we  are  cancelling  block  by  block  the  arm  dynamics  expressed  in  Figure 
7  (we  exclude  motor  dynamics,  that  have  already  been  cancelled  by  the  inner  loop).  A  scheme  equivalent 
to  this  one  was  developed  in  [2],  [3]  for  single-link  lightweight  flexible  arms.  Because  we  use  a  special 
configuration  that  decouples  radial  from  angular  motions,  components  1  and  2  of  that  cancelling  scheme 
are  very  simple:  0m\  may  be  approximately  expressed  as  a  linear  function  of  <p  and  9mi  as  a  linear 
function  of  p  in  component  1;  and  /  is  a  constant  diagonal  matrix  in  component  2. 

Finally,  we  mention  that  this  scheme  can  be  easily  extended  to  lightweight  flexible  arms  of  n-degrees 
of  freedom. 
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4.  Experimental  results 

4.1.  Apparatus 

We  have  designed  and  built  an  apparatus  to  enable  real-time  control  experiments  with  a  two-joint,  planar 
arm.  As  shown  in  Figure  11,  the  apparatus  comprises  an  air  table;  arm,  with  tip  mass,  two  actuators  and 
joint  sensors;  camera  for  tracking  position  of  tip-mounted,  infrared  LED;  and  control  computer. 

The  mechanical  system  was  designed  to  closely  approximate  the  behavior  of  the  ideal  system;  i.e.  the 
arm  is  very  light  in  weight,  carries  an  effective  point  mass  at  its  tip  and  has  minimal  friction  and  backlash. 
The  arm  is  constructed  of  music  wire,  .047"  and  .063”  diameter,  and  has  a  total  mass  of  about  .045  #m. 
The  tip  mass  is  a  disk  that  floats  on  the  air  table,  and  has  a  pivoted  connection  so  that  it  does  not  generate 
torques  on  the  tip  of  the  arm;  thus  it  appears  to  the  arm  as  a  mass  concentrated  at  the  tip.  Tip  mass  is 
adjustable  by  using  different  disks,  but  is  typically  0.12  #m.  Thus  tip  mass  is  substantially  greater  than 
arm  mass,  and  a  lumped-mass  model  is  reasonable.  Small  ball  bearings,  used  at  the  three  passive  joints 
of  the  arm,  minimize  friction.  Tests  have  shown  the  friction  on  the  air  table  to  have  negligible  effect  on 
the  behavior  of  the  system.  The  dimensions  of  the  arm  arc;  1  =  9",  O  -  A  =  3”,  and  B  -  C  =  1.5".  A 
strut  was  connected  between  the  middle  points  of  bars  A  -  B  and  C  -  O  in  order  to  prevent  buckling  in 
link  A  -  B:  and  to  minimize  the  deviation  from  ideal  behavior  due  to  unequal  bending  in  the  two  links 
(see  Figure  12). 

Joint  actuators  are  DC  torque  motors.  An  Inland  QT-2404B  motor,  rated  at  36  #-in  peak  torque,  drives 
the  base  link  (O  -  A)  directly.  A  second  motor,  Inland  model  QT-1207D,  rated  at  1.25  #-in,  rides  on 
the  base  link  and  generates  torque  between  the  base  link  ( O  -  A)  and  first  link  ( O  -  C),  through  a  3:1 
gear  reduction.  Torques  available  from  the  motors  are  greater  than  the  bending  strength  of  the  arm.  so 
torque  limits  are  not  a  factor  in  the  tip-control  servo.  Motor  response  is  generally  fast  compared  to  the  tip 
response,  although  this  is  affected  by  amplifier  current  limits,  which  arc  adjusted  in  the  range  of  .5  to  4 
amps.  One  Inland  model  EM  19-48030- BO  I  linear  current  amplifier  is  used  for  each  motor.  Experiments 
showed  that  Coulomb  friction  at  the  motor  joints  is  considerable,  so  our  method  is  especially  appropiate 
to  control  this  arm. 

Three  sensors  arc  provided  for  control:  one  for  each  joint,  and  one  for  the  tip.  Joint  sensors  are 

single-tum  potentiometers  connected  directly  to  the  motor  shafts:  a  2"  unit  for  the  larger  motor  (QT- 

2404)  and  a  7/8"  unit  for  the  smaller.  A  Hamamatsu  tracking  camera,  model  PSD,  with  infrared  passing 
filter,  provides  ±5v  signals  for  the  x  and  y  positions  of  an  LED  attached  to  the  tip.  Range  of  travel  within 

the  field  of  view  of  the  camera  is  between  7-15"  in  x  axis  and  about  ±4"  in  y  axis. 

A  Sun/Ironics  computer  system  provides  for  real-time  control,  program  development,  and  data  display 
and  analysis.  The  system  includes  a  Sun  3/160  workstation  and  Ironies  IV3201  CPU  connected  via  the 
Sun  VME  bus,  and  Ironies  IV1645-01  A/D  and  IV1640-01  D/A  boards  providing  analog  input  and  output. 
The  Sun  provides  a  networked  Unix  environment  for  program  development,  interface  with  the  the  real¬ 
time  control  hardware,  and  storage  and  display  of  data.  Control  programs  are  written  in  C.  and  compiled 
to  run  on  the  Ironies  CPU,  under  the  Chimera  operating  system  developed  at  CMU  for  real-time  control. 
Chimera  provides  process  scheduling  and  control  primitives  that  facilitate  real-time  control  programming, 
while  emulating  many  UNIX  utilities  for  programming  convenience. 


11 


4.2.  Identification 

The  dynamics  of  the  arm  have  been  divided,  for  modelling  and  control  purposes,  into  two  submod¬ 
els:  motors  submodel  and  mechanical  structure  submodel,  which  are  coupled  by  the  torques  at  the  two 
motors  (see  Figure  13).  It  was  shown  that  this  way  of  modelling  flexible  arms  has  some  advantages 
over  other  methods  when  dealing  with  arms  with  strong  Coulomb  friction  in  the  joints  [1-3].  In  our 
identification  procedure,  we  follow  this  approach  identifying  both  submodels  separately. 

4.2.1.  Mechanical  Structure 

We  use  here  the  experimental  method  indicated  in  Subsection  2.3..  We  immobilized  the  two  motors, 
we  deflected  the  arm  by  applying  an  arbitrary  force  to  the  tip,  and  then  released  the  tip.  The  oscillation 
produced  at  the  tip  had  two  orthogonal  components  of  different  frequencies,  as  it  was  stated  in  Section  2. 

In  order  to  know  the  two  vibrational  modes  and  their  directions,  we  used  the  following  technique: 

1.  Record  the  x  -  y  motion  of  the  tip. 

2.  Calculate  the  Fourier  transform  of  these  two  signals  x(t)  and  y (r). 

3.  The  spectral  analysis  shows  that  x(u>)  presents  two  peaks  x\  and  xz  at  frequencies  u>\  and  u^;  and 
y(u)  has  other  two  peaks  y\  and  yz  at  the  same  frequecies  u>i  and  u>z  as  x(u>).  u\  and  uz  are 
the  frequencies  of  the  two  vibrational  modes.  And  the  directions  of  the  axes  of  oscillation  are 
calculated  from  the  expression: 

0,- =  arctan(— )  1=1,2.  (17) 

This  procedure  is  repeated  for  different  arm  configurations  (different  p).  We  used  the  Matrixx  package 
for  analysis  and  simulation  of  control  systems.  In  particular,  we  calculated  the  above  mentioned  Fourier 
transforms  using  the  FFT  routine  of  this  package.  Experimental  results  are  given  in  the  next  table  for  our 
particular  arm: 


p  (inches) 

p/(2 

0  wi  (hz) 

0t  (degrees) 

W2  (hz) 

02  (degrees)  kb  (in  •  #) 

kc  (in  •  #) 

10.1 

0.56 

0.6514 

13.7781 

2.1983 

106.1437 

11.57 

6.14 

10.55 

0.59 

0.6839 

14.3237 

2.1332 

102.3821 

12.3 

6.54 

11.0 

0.61 

0.6839 

15.3966 

2.0844 

104.9338 

11.6 

6.58 

11.6 

0.64 

0.7328 

17.2057 

1.9866 

103.7644 

12.9 

6.77 

12.2 

0.68 

0.7491 

19.0925 

1.9215 

104.1487 

12.5 

6.82 

12.6 

0.7 

0.7653 

20.9127 

1.9052 

111.4644 

12.5 

6.87 

13.0 

0.72 

0.7816 

22.6677 

1.90 

112.6137 

12.3 

6.99 

13.6 

0.76 

0.7979 

26.173 

1.9215 

116.3932 

11.9 

7.0 

14.0 

0.78 

0.7979 

28.5903 

1.8889 

119.2472 

11.3 

6.75 

Table.  Experimental  vibrational  modes. 

where  the  stiffnesses  of  the  single  links  kb  and  k<  are  calculated  using  the  following  procedure: 
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1.  Calculate  the  compliances  cu  and  cv  in  the  principal  coordinate  axes  using  the  expression 

1  _  1 
Cy  —  T  t  Cv  —  "  k  . 

mu\  mu 2 

2.  Calculate  matrix  C,  from  cu  and  cy,  by  carrying  out  the  matrix  transformation  that  corresponds  to 
rotating  an  angle  tp\  these  main  axes. 

3.  Calculate  kb  and  kc  from  expressions  (10)-(12). 

These  experimental  results  show  that  values  kb  and  kc  are  quite  consistent.  We  will  use  in  our  control 
the  average  of  the  table  values:  kb  =  12.1  and  kc  =  6.7.  Notice  that  both  modes  are  approximately 
orthogonals:  =  xJj\  +  90. 

Finally,  in  order  to  complete  the  verification  of  our  theoretical  model,  we  took  out  the  strut  between 
bars  A  -  B  and  C  -  O  (to  simplify  the  model  and  the  verification),  and  repeated  the  experiment  for  one 
configuration: 

P  (.inches)  p/(2-  [)  u\  (hz)  i>\  (degrees)  w2  (hz)  vz  (degrees)  kb  (in  •  #)  kc  (in  •  #) 

10.55  0.59  0.6188  11.5842  2.003  100.6535  9.09  6.39 


The  theoretical  individual  stiffnesses  were  calculated  for  this  case,  using  our  massless  flexible  arm 
model,  and  they  were:  9.02  in  ■  #.  and  6.63  in  •  #.,  which  substantially  agreed  with  the  result  of  this  last 
experiment.  All  these  results  confirm  the  assumption  of  arm  with  massless  links  and  joints,  with  all  its 
mass  concentrated  at  the  tip. 

4.2.2.  Motors  Parameters 

In  order  to  identify  the  motor  submodel,  the  mechanical  structure  (links)  was  taken  out  from  the  motors. 
Then  the  coupling  torque  between  motors  and  arm  was  zero  (Cr,  in  expression  (14)),  and  the  motors  could 
run  freely.  In  what  follows,  the  parameters  of  the  second  motor,  which  has  some  reduction,  will  not  be 
given  in  motor  terms  but  in  joint  terms. 

First,  we  identified  the  Coulomb  friction  CF,  because  it  is  a  nonlinear  term.  We  obtained  Coulomb 
friction  values  from  measuring  the  current  at  which  the  motors  started  to  move  and  they  were:  0.12  amps. 
for  the  first  motor  and  0.16  amps,  for  the  second.  Once  we  knew  them,  we  were  able  to  approximately 
compensate  for  the  Coulomb  friction  by  adding  a  term  to  the  current  with  the  estimated  absolute  value 
and  the  sign  of  the  motor  velocity,  as  was  described  in  Subsection  3.2. 

After  compensating  for  the  Coulomb  friction,  the  remaining  dynamics  are  linear  and  can  be  identified 
by  any  of  the  standard  techniques.  The  model  is  now: 


frm(j)  _  _j_ 
Us)  s(J+$)’ 


i=  1,2. 


(18) 


The  parameters  that  remain  to  be  identified  arc  the  motor  inertias  /,  and  the  dynamic  frictions  V,.  The 
electromechanical  constant  of  the  motors  K,  are  obtained  from  catalog.  We  estimate  /,  and  V,  from  the 
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frequency  response  of  the  system.  The  Bode  plot  of  the  magnitude  of  the  frequency  response  shows  that 
the  response  has  a  slope  of  -20  db  at  low  frequencies  and  -40  db  at  high  frequencies.  These  parameters 
can  be  easily  calculated  from  two  points  of  this  plot.  We  used  the  following  two  points:  the  point  at 
which  the  slope  changes  from  -20  to  -40  db,  and  a  point  at  high  frequencies.  The  identified  transfer 
functions  were: 


Motor  1  : 


636.5 

s  ■  (s+  16.38) 


Motor  2  : 


_  23150 

'll  s  ■  (s  +  35.3)' 


(20) 


4.3.  Control 

4.3.1.  Motor  control  loop 

The  decoupling  term  of  Figure  9  was  implemented,  as  well  as  the  compensation  term  for  the  Coulomb 
friction.  Controllers  for  the  motor  position  were  designed  according  to  this  scheme.  We  tried  to  make  the 
response  of  the  motors  as  fast  as  possible,  but  without  having  any  overshoot  Limits  in  the  velocity  of 
response  were  given  by  the  amplifier  current  limits,  which  were  4  amps,  for  the  first  motor  and  2  amps. 
for  the  second.  We  used  a  sampling  time  of  3  msec,  in  this  inner  loop. 

The  following  experiment  was  carried  out  to  test  the  motor  control:  the  tip  was  kept  fixed  in  the 
position  (12  inch.,  0  mrad.)  in  polar  coordinates,  and  steplike  position  commands  were  generated  for  the 
motors.  The  commanded  positions  for  the  motors  were  such  that  would  have  placed  the  tip  in  positions 
(10.82  inch.,  -50  mrad.)  and  (13.18  inch.,  50  mrad.)  if  the  tip  had  been  free.  Because  the  tip  was  fixed 
at  the  intermediate  position  between  these  two,  the  arm  experienced  substantial  bending  when  the  motors 
tried  to  follow  these  trajectories,  and  the  coupling  torques  Cr,  were  significant.  Figure  14  shows  the 
motor  responses  and  the  currents  obtained  in  this  experiment  using  the  control  scheme  of  Figure  9.  The 
responses  have  nearly  zero  steady-state  error  which  shows  the  effectiveness  of  the  coupling  torque  and 
Coulomb  friction  compensation.  The  settling  time  is  about  80  msec  in  both  motors;  this  means  that  the 
time  constants  of  the  motor  control  loops  are  about  20  msec.  These  dynamics  are  significantly  faster  than 
the  dynamics  of  the  mechanical  structure  (modes  of  vibration),  confirming  the  assumption  that  the  inner 
loop  dynamics  are  negligible.  Figure  15  shows  the  responses  when  the  coupling  torque  compensation 
term  has  been  removed,  and  Figure  16  shows  the  responses  when  the  Coulomb  friction  compensation 
term  has  been  removed.  The  basic  effects  of  removing  these  terms  are  the  permanent  errors  that  appear 
in  these  last  two  figures,  the  transient  responses  experience  little  change. 

423.2.  Tip  control  loop 

The  scheme  of  Figure  10  is  used  here  to  control  the  tip  position.  The  motions  are  directly  commanded 
in  polar  coordinates,  so  the  first  block  of  that  figure,  that  transforms  from  cartesian  to  polar  coordinates, 
is  not  needed.  Second  order  parabolic  profiles  are  used  as  reference  trajectories,  so  the  reference  pr 
describes  a  parabola  and  so  does  The  sampling  time  of  the  tip  position  control  loop  is  also  3  msec., 
like  in  the  motor  loop. 
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P.D.  controllers  were  used  first,  instead  of  P.D.I.’s.  We  wanted  the  same  response  in  p  and  7,  so  the  two 
P.D.  controllers  had  about  the  same  coefficients.  Measurements  given  by  the  camera  had  significant  noise 
so  the  estimations  of  the  velocities,  needed  in  the  derivative  term  of  the  P.D.  controllers,  were  obtained 
by  using  the  discrete  differentiation  (1  -  z~5)/( 5  •  T)  instead  of  the  typical  (1  -  z~l)/T.  Experimental 
results  showed  good  agreement  with  the  theoretical  analysis  of  the  temporal  response,  but  they  showed  a 
permanent  error  probably  caused  by  kinematic  modelling  errors.  Then,  in  order  to  remove  that  error,  we 
used  P.D. I.  controllers  for  both  p  and  7  loops. 

We  carried  out  experiments  on  arm  tip  positioning  using  the  complete  scheme  of  Figure  10.  We  moved 
the  arm  from  the  point  (10.82  inch.,  -100  mrad.)  to  the  point  (13.18  inch.,  100  mrad.)  and  viceversa.  We 
programmed  a  high  speed  motion  (it  had  to  go  from  one  position  to  the  other  in  0.4  sec.).  Responses  are 
shown  in  Figures  17  to  26.  Figure  19  shows  the  estimated  tip  velocity  in  polar  coordinates;  and  Figure  20 
shows  that  motors  follow  very  closely  their  references,  confirming  the  assumption  that  the  dynamics  of 
the  inner  loop  are  negligible.  This  motion  was  then  repeated  under  limit  conditions,  using  the  maximum 
allowable  accelerations  (now  the  motion  was  programmed  to  last  0.2  sec.).  The  results  are  shown  in 
Figures  27  and  28. 


5.  Conclusions 


Lightweight  arms  have  the  advantages  of  being  easy  to  move,  and  being  more  efficient  than  heavier 
arms  because  very  little  energy  is  wasted  in  moving  the  arm  structure.  In  turn,  these  arms  usually  exhibit 
some  flexibility  phenomena  that  cause  nearly  undamped  oscillations  to  appear  in  the  mechanical  structure 
during  the  motion. 

A  two-degree-of-freedom,  planar,  very  lightweight  flexible  arm  has  been  designed,  built  and  controlled 
in  our  laboratory.  The  motor  of  the  second  joint  was  mounted  near  the  base  of  the  arm  to  minimize  inertia, 
and  a  four-bar  linkage  transmitted  the  motion  from  the  motor  to  this  joint.  This  linkage  was  specially 
designed  to  approximately  decouple  radial  from  angular  tip  motions.  This  arm  exhibited  two  orthogonal 
vibrational  modes  that  changed  in  value  and  orientation  with  the  configuration. 

A  simple  dynamic  model  has  been  developed  for  this  arm  based  on  the  use  of  two  submodels:  one 
to  describe  the  motors,  and  the  other  to  describe  the  mechanical  structure,  the  two  coupled  through  the 
torques  that  the  links  generate  on  the  motors.  A  control  scheme  has  been  deduced  from  this  model  which 
is  robust  to  changes  in  the  dynamic  friction  of  the  motor,  and  that  removes  the  effects  of  the  Coulomb 
friction.  This  control  scheme  is  based  on  very  simple  concepts,  and  each  term  of  the  controller  is  designed 
according  to  very  precise  directions:  terms  that  cancel  Coulomb  friction,  terms  that  decouple  the  motors 
from  the  arm.  inner  loop  controller  to  make  the  motor  response  fast,  cancelling  terms  for  the  mechanical 
structure  dynamics,  feedforward  term  for  the  tip  response,  etc. 

Experimental  results  have  been  presented,  and  they  show  that  our  control  scheme  performs  well. 

Our  control  scheme  is  based  on  the  assumption  that  motor  dynamics  are  much  faster  than  mechanical 
structure  dynamics.  This  point  must  be  confirmed  before  closing  the  tip  position  loop.  The  decoupling 
between  radial  and  angular  motions  achieved  by  the  four-bar  linkage  simplifies  kinematic  considerations, 
but  is  not  a  necessary  condition  of  our  control  method. 

Finally,  this  method  may  be  easily  extended  to  lightweight  flexible  arms  with  any  number  of  degrees 
of  freedom. 
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Figure  3:  Actuators  location. 


Figure  5:  Equivalent  spring  model  of  lightweight  two  d.o.f.  flexible  arms, 
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Figure  8:  Control  scheme  insensitive  to  friction. 


r 


_  if 

TcrT  s(s+ji) 


Figure  9:  Implementation  of  the  inner  loop  in  one  motor. 
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Figure  11:  Experimental  setup. 
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Figure  15:  Responses  of  ihc  inner  loop  without 
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Figure  17:  Tip 
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e  22.  Reference  lip  acceleration  (in  polar  coordinates). 
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Figure  27:  Tip  response  in  polar  coordinates  to  a  trajectory  with  the  maxii 
allowable  accelerations. 


maximum  allowable  accelerations. 
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